robot path planning with avoiding obstacles